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ABSTRACT 

This paper presents the development and performance of a special algorithm for estimating the attitude and 
angular rate of a spacecraft. The algorithm is a pseudo-linear Kalman filter, which is an ordinary linear Kalman filter 
that operates on a linear model whose matrices are current state estimate dependent. The nonlinear rotational 
dynamics equation of the spacecraft is presented in the state space as a state-dependent linear system. Two types of 
measurements are considered. One type is a measurement of the quaternion of rotation, which is obtained from a 
newly introduced star tracker based apparatus. The other type of measurement is that of vectors, which permits the 
use of a variety of vector measuring sensors like sun sensors and magnetometers. While quaternion measurements are 
related linearly to the state vector, vector measurements constitute a nonlinear function of the state vector. Therefore, 
in this paper, a state-dependent linear measurement equation is developed for the vector measurement case. The state- 
dependent pseudo linear filter is applied to simulated spacecraft rotations and adequate estimates of the spacecraft 
attitude and rate are obtained for the case of quaternion measurements as well as of vector measurements. 

INTRODUCTION 

Precise angular-rate is required for spacecraft (SC) attitude determination, and a coarse rate is needed for 
attitude control damping. Classically, angular-rate information is obtained from gyros; however, these days, there is a 
tendency to build smaller, lighter and cheaper SC where rate accuracy can be compromised. Therefore, the 
inclination now is to do away with gyros and use other means to determine the SC angular-rate. In fact other means 
are needed even in gyro-equipped satellites when the angular-rate is out of range of the SC gyros. 

There are several ways to obtain the angular-rate in a gyro-less SC. When the attitude is known, one can 
differentiate the attitude in whatever parameters it is given and use the kinematics equation that connects the 
derivative of the attitude with the satellite angular-rate in order to compute the latter (ref. 1, 2). However, the 
differentiation of the attitude introduces a considerable noise component in the computed angular-rate vector. To 
overcome this noise, one can use an active filter, like a Kalman filter (KF) (ref. 3, 4). 

All these methods use the derivative of either the attitude parameters or of the measured directions, which 
normally determine the attitude parameters. Another approach is that of using the attitude parameters, or the 
measured directions themselves, as measurements in a KF. The dynamics model of that KF also includes the SC 
angular dynamics equation, which is a nonlinear first order vector differential equation. In this case, the kinematics 
equation that connects the attitude parameters, or the directions, with their derivatives are included in the dynamics 
model used by the filter thereby the need for differentiation is eliminated (ref. 5, 6). The KF dynamics model also 
includes the SC angular dynamics equation, which is a nonlinear first order vector differential equation. 
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New sensor packages that uses star trackers and yield the SC attitude in terms of the attitude quaternion 
recently became available 1 . Therefore, it became possible to use the quaternion supplied by such sensors as 
measurements. This approach was indeed used in a recent work (ref. 7) where the nonlinear dynamics equation was 
converted to a state-dependent pseudo-linear equation but the measurement equation was linear. The pseudo-linear 
dynamics model together with he linear quaternion measurement model enabled the use of PSEudo Linear KAlman 
(PSELIKA) filter. 

While the use of quaternion measurement yielded very satisfactory results, the algorithm was limited to one 
type of instrumentation package, consequently, the popular vector measuring devises like sun sensors, 
magnetometers, horizon sensors and others could not benefit from the PSELIKA estimator for estimating attitude and 
angular rate. 

In the present work we add a development, which enables the use of the elementary vector observations as 
filter measurements rather than the quaternions derived from them. On one hand, this approach allows the use of a 
wide range of instruments to track the SC attitude, but on the other hand, it introduces nonlinear measurement 
equations. However, as shown in this paper, these measurement equations can be transformed into a state-dependent 
pseudo-linear equation thereby permitting the use of the PSELIKA filter. 

In the next section we briefly describe the development of the filter dynamics equation and, in particular, the 
development of the state-dependent pseudo-linear SC angular equation. Then, in the following section we present the 
development of the pseudo-linear measurement equation associated with vector measurements. In the section that 
follows this one, we present the PSELIKA filter. Next, we present computer runs for vector measurements that, as 
mentioned, involve pseudo-linear dynamics as well as pseudo-linear measurement equations, and compare them with 
the results obtained when using quaternion measurements, which involve pseudo-linear dynamics but truly linear 
measurement equations. Finally, in the last section we present the conclusions derived from this work. 

THE STATE-DEPENDENT DYNAMICS EQUATION 

The angular dynamics of a constant mass SC is given in the following equation (ref. 8, p. 523) 

Itb + h + (Ox(Io> + h) = T (1) 

where I is the SC inertia matrix, CD is the angular velocity vector, h is the angular momentum of the momentum 
wheels, and T is the external torque acting on the SC. Since the inertia matrix I is invertible we may write this 
equation as 


ob = I" 1 [(Ico + h)x]co + 1' 1 (T - h) (2) 

where [ax] denotes the cross product matrix of the general vector a . Defining 

F (to) = I -1 [(Ig> + h)x] (3. a) 

and 

u(t) = r 1 (T-h) (3.b) 

Eq. (2) can be written as 

<b = F (to)® + u(t) (3.c) 

As was noted by Cloutier, D’Souza, and Mracek (refs. 9, 10) the decomposition of Itoxoo into [Itoxjto is not 
unique. In fact there are eight possible ways to decompose the vector (ref. 1 1), consequently there are eight primary 
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dynamics matrices which express the angular dynamics of an SC; that is, we have Fj (to) i — 1 , 2, 8 for which 
F, (co)co = F^ (co)co = = F 8 (co)co but 


F| (®) ^ Fj (to) * * F g (to) 


(4) 


Although there are only eight primary representations, one can generate infinite secondary dynamics matrices as 
linear combinations of the primary matrices by forming (refs. 9, 10) 

8 8 

E i(®) = X a ijFj(©) where S a i.j =1 i = 1 , 2 ,...,— > co (5) 

j=t j=i 

This can be easily proven when noting that 

8 8 8 

E|(co)to = ^a ij Fj(ro)© = 2]a ij f(cD) = f(co)5]a ij =f(co) (6) 

i=i i=i i=i 

where f(to) = I 1 [(I<X> +h)x]co . We conclude then that the representation of the SC dynamics equation in the 
form 


x = F ffl (x)x + u a (t) 


(7) 


is not unique, and that there are exactly eight different ways to express the nonlinear SC dynamics equation by basic 
state-dependent linear equations, and infinite secondary such equations. 

The attitude is best described by the quaternion of rotation. The quaternion dynamics equation is (ref. 8, p. 512) 


q = iQco 

where 

q 4 — ^3 q 2 
Q= q 3 q 4 -qi 
-q 2 q. q 4 

qi — q 2 — q3 

Grouping Eqs. (2) and (8) yields 



’r'tCio+^x] 0' 

to 

4. 

r 1 (T-h)’ 

tQ 0 

_q_ 

1 

0 


( 8 ) 


(9) 


( 10 ) 


In order to use the last equation as a dynamics equation in a KF, we need to add to it white noise to account for 
modeling inaccuracies. This results in the following dynamics equation. 


to 

= 

~r'[(i<o + h)x] o’ 

CO 

+ 

r 1 (T-h)’ 

+ 

’ W <o’ 

q_ 


IQ 0_ 

_q_ 


0 


w q _ 


where accounts for the inaccuracies in the modeling of the SC angular dynamics and w q accounts for modeling 
errors of the quaternion dynamics. 
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THE STATE-DEPENDENT MEASURMENT EQUATION 

As mentioned earlier, a measurement system has been introduced recently 1 , which yields the attitude directly in a 
form of a quaternion of rotation. In this case the measurement equation is linear; namely, 


q m = [°4X3 



( 12 ) 


where q m is the measured quaternion and v q is the noise associated with this “measurement”. The actual 

measurements are vector measurements obtained from star trackers out of which the “measured” quaternion is 
computed. Traditionally though, it is the vector measurements which are used directly to estimate the attitude. In this 
case the link between the measurements and the attitude expressed by the quaternion of rotation is a nonlinear one. 
However, this nonlinear relationship can too be expressed as a state-dependent pseudo-linear function. This is shown 
next. Let r denote the measured vector expressed in the reference coordinate system and let b denote the 
measurement of this vector as obtained in body coordinates. The relationship between the two vectors is expressed by 

b = Dr + v (13) 


where D is the direction cosine matrix that transforms vectors from the reference to the body coordinates, and V 
denotes the zero mean white noise associated with this measurement. It is well known that D is the following 
function of the quaternion elements (ref. 8, p. 414) 


D = 


2 2 2 2 

qi -q 2 -q 3 +q 4 

2(q,q 2 -q 3 q 4 ) 
2(q,q 3 +q 2 q 4 ) 


2(q,q 2 + q 3 q 4 ) 

2 2 2 2 

-q, +q 2 -q 3 + q 4 

2(q 2 q 3 -q,q 4 ) 


2(q,q 3 -q 2 q 4 ) 
2(q 2 q 3 +q,q 4 ) 
-q'-q 2 +q 3 +q 4 


when the last expression is substituted into Eq. (13) we obtain 


b = 


(q? -<& -q 3 2 +q4) r i + 2 (q,q 2 +q 3 q 4 ) r 2 +2(q,q 3 -q 2 q 4 )r 3 
2(qiq 2 -q 3 q4) r i +(-q? + q 2 -q 3 + q 4 )r 2 + 2 (q 2 q 3 +qiq4) r 3 

2(q,q 3 +q 2 q 4 )r, +2(q 2 q 3 -q,q 4 )r 2 + (-q 2 -q 2 +q 2 +q 4 )r 3 


+ v 


(14) 


(15) 


An expansion and rearrangement of the terms in the last equation yields 


b = 


qiT +q,q 2 r 2 + q 1 q 3 r 3 -q'q + q,q 2 r 2 -q 2 q 4 f 3 -q 3 r, +q 3 q 4 r 2 +q,q 3 r 3 +q 4 r, +q 3 q 4 r 2 -q 2 q 4 r 3 
q^iT -q?^ +qiq 4 r 3 +q 1 q 2 r 1 +q 2 r 2 +q 2 q 3 r 3 -q 3 q 4 r , -q 3 r 2 +q 2 q 3 r 3 -q 3 q 4 r, +q 4 r 2 + qiq 4 r 3 
q 3 q 3 r i -q,q 4 r 2 -q?r 3 +q 2 q 4 ri +q 2 q 3 r 2 -q 2 r 3 -L q,q 3 r , +q 2 q 3 r 2 +q^j +q 2 q 4 r, -q,q 4 r 2 +q,r 3 


+ v 


which can be written as 


...(16) 


1 Van Bezooijen, R.W.H., "AST Capabilities," Lockheed Martin Advanced Technology Center, Palo Alto, CA 
95304-1 191. (Slide presentation). 
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Vi +q 2 r 2 +q 3 r 3 

-q 2 r i+qir 2 -q 4 r 3 

-q 3 r i+q 4 r 2 +qi r 3 

q 4 r i+q 3 r 2 -q 2 r 3 ’ 

’qi" 

q 2 

q 3 

q 2 r 1 -qir 2 +q 4 r 3 

qi r i+q 2 r 2 +q 3 r 3 

-q 4 r i -q 3 r 2 +q 2 r 3 

-q 3 r, +q 4 r 2 +qi r 3 

_q 3 r i-q 4 r 2 -qi r 3 

q 4 r i+q 3 r 2 -q 2 r 3 

qi r i+q 2 r 2 +q 3 r 3 

q 2 r, - q] r 2 +q 4 r 3 _ 




_q 4 . 


+ V 


...(17) 


Let 


H(r,q) = 


qi r i + q 2 r 2 + q 3 r 3 - q 2 q + qi r 2 - q 4 r 3 - q 3 q + q 4 * 2 + qi r 3 q 4 q + q 3 r 2 - q 2 r 3 

q 2 q - qif 2 + q 4 r 3 qi r . + q 2 r 2 + q 3 f 3 - q 4 q - q 3 r 2 + q 2 r 3 - q 3 r i + q 4 r 2 + qi r 3 

q 3 q -q 4 r 2 -qi r 3 q 4 q +q 3 r 2 -q 2 r 3 qiq +q 2 r 2 +q 3 r 3 q 2 q -q,r 2 +q 4 r 3 _ 


then Eq. (17) can be written as 
which can be written as 


b = H(r,q)q + v 


[0 H(r,q)j“ 


(18) 

(19) 

( 20 ) 


b = |0 H(r,q)| l + v 

q. 

We have thus succeeded in expressing the vector measurement equation as pseudo-linear equation. 

THE PDEUDO-LINEAR KALMAN FILTER 

The pseudo linear KF (PSELIKA) is an ordinary linear Kalman filter where the state-dependent coefficients are 
functions of the best available state estimate. Let 


X = 


u(t) = 


r'(T-h) 


0 


(2 l.a) 


(21.c) 


F(«>) = 

w(t) = 


r'[(i®+h)x] o 


±Q 


0 


w. 


w. 


(2 l.b) 
(21.d) 


then Eq. (11) can be written as 


x = F(«)x + u(t) + w(t) 

From Eq. (12) we obtain the following corresponding quaternion measurement equation 


( 22 ) 


a = H q 

4mk+l 1X k+l 


+ V 


q,k+l 


where 


^.,=[04,3 Ij 

and from Eq. (20) we obtain the following corresponding vector measurement equation 


(23. a) 
(23. b) 


where 


b ..m = H L( r >s)| 

HL=[0 H(r,q>] 


+ V 


b,k+l 


(23. c) 
(23. d) 
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Filter initialization: 


Compute: 


Q k =E{w(t k )w(t k ) T } 

(24. a) 

R q ,k+i =E{v qk+1 vJ k+1 } 

(24. b) 

E-b.k+1 = E{v bjk+) V bk+1 } 

(24. c) 


and choose an approximate value for the initial estimate of the state vector. In the absence of such initial estimate, 
choose: 


x o=[“o qj] = [0 0 0 0 0 0 l] 


(24. d) 


Time propagation: 

Solve simultaneously the differential equations 

(25. a) 
(25. b) 


X = F(x)x + u(t) 

P = F(x)P + PF t (x) + Q 


between t k and t k+I using the definition x(t k ) = i tt , P(t k ) = P k/k , x k+)/k = x(t k+1 ) , and P k+1/k = P(t k+I ) . 
(The subscript q/p denotes the estimate at time t q based on the measurements up to time t p ). 


Measurement update: 

For quaternion measurements: 


+R,, M r' 

X k+l/k+l = X k+l/k +K k+ ,[qm.k + l _ H k+1 X k+1/k ] 

^k+i/k+i ~ [I 'K- k+1 H k+1 ]P k+1/k [I - K k+1 H k+1 ] +K k+I R k+] K 


k+1 


(26. a) 
(26. b) 
(26. c) 


For vector measurements: 


K-k+l = Pk+l/kH k+ i (r k+ i 5 q k +l/k )[H k+ i ( r k+l ’Qk+l/k )Pk+l/k^k+l ( r k+l ’ Qk+l/k ) + ^b.k+l ] 

X k+l/k+l = X k+l/k + K k+ i [b m k+! ~ H k+] (r k+ i ?q k+ ]/k ) X k+l/k ] 

^k+l/k+l = P "K k+ iH k4 .i( r k +1 ,qk+l/k)]Pk+l/kP ' ^ k+1 ^ k+1 (**k+l s^k+l/k )] + K k+1 R b k+1 K k+1 


(27 .a) 
(27 .b) 
(27. c) 


SIMULATION RESULTS 

In order to test the PSELIKA filter a simulation program was constructed. The simulation included a given 
profile of the wheel momentum, h(t) , that generated the desired true angular velocity vector. Based on that data the 
corresponding true SC attitude was computed in terms of the true quaternion. White measurement noise was added to 
the true quaternion and the resultant noisy quaternion served as the measured signal for the case where the PSELIKA 
filter used measured quaternions to estimate the SC attitude and angular rate. The noise vector was zero mean and 
white. Its standard deviation was 0.00001 for each component. Fig. 1 presents the true and estimated angular velocity 
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components. The estimation error of the angular velocity for this case is presented in Fig. 2. Since the measured 
quantity was the quaternion itself, the attitude errors were on the level of the noise. They were, of course, very small. 
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Fig. 3: True and Estimated SC Angular Rate Using Two Simultaneous Vector Measurements. 


In order to simulate the case where the estimator used measured vectors, the following two reference vectors 
were assumed 


r, T = [l 0 0] 

r 2 ‘ = [0 1 0] 


(28) 


They represented sun sensor and magnetometer measurements, respectively. The corresponding vectors in body 
coordinates, b, and b 2 , were computed by transforming r, and r 2 ■ by the true attitude matrix. White measurement 
noise was added to the true b, andb 2 vector. The noise was zero mean and its standard deviation was 0.01 per 
component of b, and 0.005 per component of b 2 . When the two measurements were used in a sequential manner at 
each update time point, the filter diverged. It was speculated that although in the truly linear case performing the two 
sequential measurement updates is identical to performing the two updates simultaneously, in the pseudo-linear case, 
where the matrices involved in the updates are functions of the estimate, there could be a difference between the two 
possible update methods. This is particularly true when estimating attitude using vectors because two vector 
measurements, determine attitude whereas one vector measurement is not sufficient for that. As a result of the 
foregoing discussion, the two measurements were stacked together to form the following measurement equation (see 
Eq. 23. c) 


^l,m,k+l 

^2,ra,k+l 


'CMwHl' 

CO 

+ 

V l,b,k+1 

H^[r > q w (-)]_ 

_q_ 


_ V 2,b,k+l_ 


(29) 


Indeed, using the two vector measurements together in the filter updates, the filter converged and produced 
satisfactory results. Figure 3 presents the true and estimated rates obtained in this case, whereas Fig. 4 presents the 
angular rate estimation error for this case. Finally, in Fig. 5 the attitude estimation error is presented for this case of 
simultaneous vector measurements. 
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Fig. 4: Angular Rate Estimation Errors Using Two Simultaneous Vector Measurements. 
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Fig. 5: Attitude Estimation Errors Using Two Simultaneous Vector Measurements. 
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CONCLUSIONS 


In this work we presented two versions of a pseudo-linear Kalman filter for spacecraft attitude and rate 
estimation, which is based on the ability to express the nonlinear parts of the system model as state-dependent linear 
models. This formulation of the model enabled the evaluation of the state-dependent matrices in terms of the best 
available state estimate, and thus to express the system model as deterministic matrices multiplying random vectors. 

In the first version of the filter, the measurement was that of the attitude quaternion, which is related linearly 
to the estimated state vector; therefore, only the nonlinear dynamics model of the spacecraft rotation had to be 
formulated in a state-dependent linear model. The second version treated a more general case where the 
measurements were vector measurements, in which case, the measurement model too was nonlinear and had to be 
formulated as a state dependent linear model. 

Simulations were performed which showed that, as expected, the first filter whose quaternion measurements 
were based on star tracker measurements yielded very good rate estimates and exceptionally good attitude results. 
The second filter, though, was unable to produce good results when the vector measurements were performed 
sequentially. However, when the two vector measurements were performed simultaneously the filter performed 
satisfactorily. The results were, of course, less accurate than with the previous algorithm, but that was because the 
simulated measurements supplied by a sun sensor and magnetometers whose inherent accuracy is less than that of star 
trackers which supplied the quaternion measurement to the first algorithm. 
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